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Abstract 

In this paper, a new bias partitioned square-root informa- 
tion filter (PSRIF) with an associated partitioned square-root 
information smoother (PSRIS) for aircraft flight state and 
parameter estimation is proposed. The new algorithm can not 
only improve the numerical robustness and precision of night 
state estimation but also make the computation more efficient 
than augmented extended Kalman filter (EKF) or conventional 
square-root information filter and square-root information 
smoother (SRIF/SRTS). The results of simulated and actual 
night test data computation of two types of Chinese aircraft 
show that the new method presented in this paper can give accu- 
rate estimates of flight state and parameter for high and low 
sampled rate and is much more numerical stable and efficient. 

Introduction 

Accurate estimation of aircraft motions from noisy or 
incomplete night test measurements by optimal estimation theo- 
ry is an important problem in the analysis of (light test expert- 
ments. The measurements may often contain significant errors 
which must be estimated before the night data are used in any 
performance calculations. These problems can be implemented 
as state and parameter estimation problem of nonlinear system. 
Solution to the problem can be obtained by Extended Kalman 
Filter (EKF) 1 u *and Maximum Likelihood (ML) 1 2J method. 
However, the ML method is not suitable to on-line processing 
of night data and can consider the case with observation noise 
only. EKF may suffer from numerical ill-conditioning. In order 
to improve the numerical stability and computation efficiency, 
A new PSRIF / PSRIS for night state and parameter estimation 
is proposed. The modified algorithm is based on a new aircraft 
flight state and parameter estimation model of separated bias 
from state vector other than conventional augmented state 
vector one. The new algorithm can not only improve the numer- 
ical robustness and precision or night state estimation but also 
make the computation more efficient than augmented EKF or 
conventional SRIF / SR1S. 

N onlinear Model for Flight State Estimation 

The six degrees of freedom nonlinear model for night state 
estimation is presented as follows: 

u — — qw + rv — ftsinO + a g 



v = — ru + pw — gcos6sin<p + a y 
w = — pv + qu — gcosOcosv + a j 

<fr m (Qstncp + rcosq>)/cos0 0) 
0 — q co sq> — rsinq> 
<p = p + qsimplgO + rcosvtgO 
h — usind— vcosBsinq> — wcosQcosqt 
- In general, the measurements of input variables, U - [a M . a f . 
a*. P. <7. rf and observation variables Z = [K, fi, *, 0, <P, Af 
corrupted by scale factor errors, biases and random noises, 
where 



°, =Q >„ + b r + l7 * 
P** P m + 



(2) 



r °f ^ + b r + rj, 

The observation equation of aircraft can be described as 

follows: / a j T , 

K„-(1+Ay« +v +w + 

a m =(\+X m )ian~ l [(w-qx u + py m )/u} + + £. j, (3) 

e m =0 + 6, + t t 
<P m = + + 

The system described by equations (l)~ (S) forms a set of 
nonlinear dynamic equations of the form: 

X(0«f (X(/), VJt). b, 17(0) «> 
Z.,«)=R CX(/), VJi). b) +«0 (5) 
where: X-[u, v. w. tfr, <p. 9. h) 

Thus, our problem can be stated as follows: Given the 
nonlinear model (4), (5) and a set of noisy input and output 
measurements, estimate the system state X and parameter b. 

New Bias Partitioned Squa re-Root 
Information Filter / Smoother 

In order to estimate the state and unknown parameters, in 
general, one can form an augmented state model, that is, set 
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the equations (4) and (5) can be rewritten as an augmented state 
formulation: 

*(/)-!, (Y(r). V m (t). ,(/)) (7) 
Z„<0-« (Y(r). U M (/)) + £(/) (8) 
Taking account for tbe unknown bias error vector b be 
supposed to be constant, linearization and discretization of 
equations (7) and (8) around a 'nominal' flight condition yields 
the following set of linear discrete-time equations of the sepa- 
rated state and bias form: 

*(k+ 1)~<^(*+ l,*)x(*)+<*^(* + ljt)b+r (* + IJr)ij(*)i 
b =b (9) 
z(k+ \)-G M (k+ l)x<* + » + (?,(* + l)b+f(* + l) (10) 
where x, z represent the deviations from their reference values. 
Thus, the dimension of system will be reduced to the larger one 
of n, or n* other than n„+n b . This would require fewer numeri- 
cal operations than the augmented state one and may avoid the 
numerical ill-conditioning caused by consideration of biases as 
the augmented state. The process noise q and measurement 
noise { sequences are assumed to be independent, zero mean 
and Gaussian with covariance Q and A, respectively. 

The PSRIF/PSRIS based on the Eqs.(9) and (10) can be 
derived and summarized as follows: 

Time update: Choose an orthogonal transformation f k% 
such that: 

f. 



■IT- 



""K: I: I:) 



o o 

where T k denotes a Householder transformation or modified 
weighted Gram — Schmidt transformation such that S n is an 
upper triangular matrix. 
Measurement update: 



'[ S>(k) 2 § (k) J"L 0 J 



(12) 



(13) 



The optimal correction x(it-H ) is calculated as follows: 

S(k + 1) -£;■(* + m M <k + 1)- S^ik + l)b(*)} (14) 

V + 1 ~s;\k+ !)!,<* +1) (15) 
The estimate of X(Ar+l) and /or the estimated covariance ma- 
trix are 

X(Jc + D-X^ + S(Jc + 1) (16) 
* a "iS^ik + l)L(k + \)]\s; '(* + i)L(k + !)l r (17) 
where: L{k + l)-[/ : - S^(k + %)S; l (k + 1)] 

Noting that the filtered estimation of b is also the 
smoothed one, then the estimation of b can be eliminated from 
the smoothing process, the dimension of the smoother can be 



reduced. The partitioned square— root information smoother 
(PSRIS) is, for k-N, N-l, 0, recursively select orthogonal 
transformation T\ such that: 

L s i r J k > ».>+» J 

[s;<*+n ^(* + o s;(*: + i) z;(* + i)1 
0 (*) ^(Jt) (*) J 

the smoothed state estimate and the smoothed state covariance 
are obtained from: 

x; =s;"(A:)[i;(fc)-5i(jt)b"] oso 

P' M - \S' a " (*)£,(*))[*; " * (*)L(*)1 r (20) 
where: £(*)-[/ : - ^^(k)S^ " (it)] 

Simulation and Application 

The new algorithm presented in this paper has been applied 
to the flight state and parameter estimation with simulated and 
actual flight test data. The results of simulation and application 
to two types of Chinese aircraft show that the new algorithm 
can give accurate estimate and is much more stable and efficient 
than EKF or conventional SRIF / SRI S. The results of estima- 
tion are given in Fig.l and Fig.2 with the sample period of 
I /32 and 1 / 10 second, respectively. It is obvious that the re- 
sults are satisfactory both for higher and lower sampling rates. 
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